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WHAT IS CLAIMED IS: 

1. A method for characterizing distortions in the earth's magnetic 
field caused by a vehicle, a magnetometer affixed to the vehicle, said method 
comprising: 

repeatedly measuring the distorted magnetic field utilizing the 

magnetometer; 

obtaining a three-dimensional orientation of the vehicle axes with 
respect to the earth at a time of each magnetometer measurement; 

receiving undistorted earth magnetic field data for the vicinity of the 
vehicle relative to the earth at the time of each magnetometer measurement; and 

utilizing the magnetic field measurements, the orientations of the 
vehicle, and the undistorted earth magnetic field data to characterize distortions 
caused by one or more of the vehicle and magnetometer errors. 

2. A method according to Claim 1 wherein obtaining an 
orientation of the vehicle axes comprises receiving pitch and roll signals from one or 
more of an attitude heading reference system, an attitude reference system, an inertial 
reference system, and an inertial reference unit. 

3. A method according to Claim 2 wherein obtaining an 
orientation of the vehicle axes comprises: 

moving a vehicle equipped with a GPS; 

determining a GPS tracking angle; and 

assuming the GPS tracking angle is the true heading. 

4. A method according to Claim 2 wherein obtaining an 
orientation of the vehicle axes comprises: 
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moving a vehicle equipped with a GPS; and 

calculating a true heading during, and immediately following, vehicle 
turns or accelerations, utilizing GPS-augmented attitude and heading reference system 
algorithms. 

5 5. A method according to Claim 1 wherein obtaining an 

orientation of the vehicle axes comprises receiving pitch, roll, and at least one of a 
true heading signal and a synthetic magnetic heading signal from an inertial reference 
system. 

6. A method according to Claim 1 wherein obtaining an 
10 orientation of the vehicle comprises: 

receiving pitch and roll signals from an attitude heading reference 

system; and 

receiving at least one of a true heading signal and a synthetic magnetic 
heading signal from an inertial reference system. 

15 7. A method according to Claim 1 wherein obtaining an 

orientation of the vehicle comprises: 

receiving pitch and roll signals from an attitude heading reference 

system; and 

determining a true heading utilizing a dual antenna GPS. 

20 8. A method according to Claim 1 wherein receiving undistorted 

earth magnetic field data comprises determining vehicle position and using a table of 
magnetic inclination and declination data for a surface of the earth. 

9. A method according to Claim 1 wherein characterizing 
distortions caused by the vehicle comprises transforming undistorted magnetic field 
25 components to distorted magnetic field components over relative orientations between 
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the undistorted magnetic field and one or more of the axes of the vehicle and the axes 
of the magnetometer. 

10. A method according to Claim 1 wherein obtaining a three- 
dimensional orientation of the vehicle axes comprises determining vehicle position 
using at least one of an inertial navigational system and ground based navigation aids. 

11. A method according to Claim 1 wherein characterizing 
distortions comprises calculating correction coefficients for the magnetometer. 

12. A method according to Claim 1 1 wherein calculating correction 
coefficients comprises compensating the magnetometer by estimating L e and H pe in 
the function H ea rth = L e * H mea s + H pe where, H ea rth is a three-dimensional vector 
representing the undisturbed Earth's magnetic field, H me as represents a three- 
dimensional vector for the disturbed Earth's magnetic field as measured by 
magnetometer, L e is a three by three (3x3) matrix of magnetic correction coefficients, 
and Hpe is a three-dimensional vector of magnetic correction coefficients. 

13. A method of compensating a magnetometer affixed to a vehicle 
to obtain accurate magnetic heading information for a vehicle orientation, said method 
comprising 

using the magnetometer to measure a distorted earth magnetic field 
relative to axes of the vehicle; 

determining a pitch and roll orientation of the vehicle axes with respect 

to the earth; 

calculating the distortion of the earth's magnetic field for any relative 
angle between the vehicle axes and the earth's undistorted magnetic field; and 

determining a magnetic heading based on the magnetometer 
measurement, adjusted by the pitch and roll orientation of the vehicle, and 
compensated for distortions of the earth's magnetic field. 
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14. A method according to Claim 13 wherein determining a 
magnetic heading further comprises compensating the magnetometer by solving the 
function H ea rth = L e * H mea s + H pe by estimating L e and H pe where, H ear th is a three- 
dimensional vector representing the undisturbed Earth's magnetic field, H mea s 

5 represents a three-dimensional vector for the disturbed Earth's magnetic field as 
measured by magnetometer, L e is a three by three (3x3) matrix of magnetic correction 
coefficients, and H pe is a three-dimensional vector of magnetic correction coefficients. 

15. A method according to Claim 13 further comprising 
augmenting pitch and roll orientation data based on magnetometer measurements and 

10 the magnetometer compensation. 

16. A method according to Claim 13 further comprising estimating 
L e and H pe based on multiple measurements of H ear th and H meas - 

17. A method according to Claim 16 wherein determining a 
magnetic heading comprises: 

15 determining vehicle position and using a table of magnetic inclination 

and declination data for a surface of the earth; 

comparing the measured magnetic field, H meas , against the magnetic 
inclination and declination data to determine the magnetic correction coefficients, H pe ; 
and 

20 providing L e and H pe as correction coefficients to the magnetometer. 

18 A method according to Claim 13 further comprising 
determining the vector of magnetic correction coefficients, H pe , and the matrix of 
magnetic correction coefficients, L e , utilizing a three-dimensional magnetic error 
table, the error table configured to maintain separate data points for multiple aircraft 
25 orientations between an actual magnetic field and vehicle pitch, roll, and yaw axes. 

19. A method according to Claim 18 wherein the magnetic error 
table comprises separate data points at 30 degree increments in yaw and at 60 degree 
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increments in pitch and roll, each data point being a three-dimensional vector of 
magnetic error relative to vehicle axes. 

20. A method according to Claim 19 comprising determining the 
correction coefficients utilizing scalar values from the data points. 

5 21. A method for determining a true earth magnetic field from a 

magnetic field measured by a magnetometer, said method comprising: 

generating a truth reference field vector, h . , from sources of pitch, roll, 

heading, and position independent of the magnetometer and a three dimensional map 
of the earth's magnetic field; 

10 determining a difference between a vector as measured by the 

magnetometer and the truth reference vector; and 

utilizing the difference to estimate corrections to magnetometer model 

coefficients. 

22. A method according to Claim 21 further comprising utilizing 
15 the difference to estimate corrections to one or more of vehicle pitch, roll, and 

heading. 

23. A method according to Claim 21 wherein pitch, roll, and 
heading data is provided by at least one of a GPS, an attitude and heading reference 
system, an inertial reference system, an inertial navigation system, and ground based 

20 navigational aids. 

24. A method according to Claim 21 further comprising utilizing 
the difference to provide corrections to attitude and heading angles of a navigation 
system. 

25. A method according to Claim 21 further comprising estimating 
25 corrections using a Kalman filter. 
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26. A method according to Claim 21 wherein generating a truth 
reference field vector comprises relating the field measured by the magnetometer h w 

to the true earth's field h according to h m = Mh + h^ , where M is a 3x3 magnetic 
permeability matrix and is a 3x1 vector of field offset errors resulting from 
permanent magnetization. 

27. A method according to Claim 26 wherein determining a 
difference comprises: 

h=M- I (h M -h p ) 

solving for the true earth's field, h, according to 

= L(fi.-fi„) 

where the matrix L is defined as L = 1VT 1 ; and 

assuming that the initial value of matrix L is equal to the identity 
matrix and the initial vector of field offset errors, h^ , is zero. 

28. A method according to Claim 27 further comprising: 

obtaining a linearized error equation for the magnetometer-measured 
and compensated body-axis earth's field components according to 

Sh = SL(h m -h)-LSh „ _ _ 

, where Ah is defined as Ah = h — h ; and 

= <5LAh-L<5h p 

forming a separate measurement equation for each field component 
from the linearized error equation according to Sh x = Ah T $l r] -l T r] Sh p , 

Sh y = Ah T Sl r2 -\ T r2 Sh p , and Sh 2 = Ah r <51 r3 -l* 3 5h , where each equation is in the 

form of a row vector multiplied by a column vector of magnetometer parameter errors 
to provide scalars that are functions of the vectors. 
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29. A method according to Claim 28 where magnetometer errors 





~Ah r 


0,,3 


0„3" 




are provided according to Sh = 


0,,3 


Ah 7 " 


0 






0„3 


0,, 3 


Ah r 





30. A method according to Claim 21 wherein generating a truth 
reference field vector, h . , from inertial data and a three dimensional map of the earth's 
magnetic field comprises: 

determining the earth's field vector in north/east/down frame 
components based on one or more of a current latitude, longitude, altitude, and 
the map; and 

transforming the earth's field vector into body coordinates to find errors 
in the "truth" source according to h, = CfC L N h N , where Cf transforms a vector from 
the local-level frame (L-frame) to the body frame (B-frame) and is the transpose of the 
attitude direction cosine matrix C, and C L N accounts for the rotation in azimuth of the 
local-level frame with respect to north by the wander angle a , and is given by 



C L = 



cos a sin a 0 
-sin a cos a 0 
0 0 1 



31. A method according Claim 30 further comprising taking partial 
differentials of h,. = Cf C^h^ according to 

Sh. =SC T C L N h N +C T SC L N h N +C r C^h" 

ttw.-i r ~m rr r ^ , n ~ a/ t j where y is the 

= [C r { y} ] CX + C T [- {c} C L N ]h N + C T C L N Sh N 

attitude error vector which represents the angular error of the L-frame relative to the 
B-frame, £ the angular position error vector which represents the angular error of the 
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L- frame relative to the earth frame (E-frame), and {v} represents the skew-symmetric 



matrix form of the enclosed vector v, defined by { v} = 



0 -v 



0 -v 



L~ v y v * 0 



32. A method according Claim 3 1 further comprising: 

estimating corrections using a Kalman filter implementing a "psi- 
angle" inertial error model where attitude error states are components of the angular 
error vector \\t defined as \|/ = y - e , which results in 

Sh f = C T {\\i}C L N h N +C T C L N 8h N 9 or by taking a reversed order cross product, 
{ v|/} C^fi" = v|/ x (c^h* ) = - (C^h" )xi|/ = - [c L N h N } i|/ , which results in 
Sh; = -C T {c L N h N ) vj; + C r C^h" . 

33. A method according to Claim 32 wherein determining a 
difference between a vector as measured by the magnetometer and the truth reference 
vector comprises stating the differences as z k = fl k x k + , where z k is a 3x1 vector 

of measurements at time t k , is a 3xn measurement matrix, is the state vector, 

and v k is the measurement noise vector. 

34. A method according to Claim 33 further comprising: 



determining the measurement vector by subtracting 



Sh; =-C r {c L N h N }\ V + C T C L N 5h N from Sh = 



Ah" 0 lx3 0 Xx3 
0 lr3 Ah T 0 



,3 0 IJC3 Ah 7 



0, 



$l-L,Sh , resulting 



z = h - h, , = 5h - Sh + v 



in 



Ah' 0 lt3 0 lr3 



0,, 3 Ah' 



0 



0,,3 0 lx3 Ah T 



SI -LSh p + C T {c L N \i N ) \|/ - C T C L N Sh N + v ' 



where v 
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represents a vector of uncorrelated measurement noise due to electromagnetic noise 
and random earth field modeling errors such as quantization. 

35. A method according to Claim 34 further comprising generating 
a measurement mapping matrix H according to 

H = [h„ 0 ... 0 H„ H 6 H fiW ], where 
H ¥ =C'{c*h"} 





0,,3 


0..3 




Ah r 


0 




0„3 


Ah r 


-L 







"p 

36. A magnetic compass compensation unit for characterizing 
distortions in the earth's magnetic field caused by a vehicle, in which said unit is 
mounted, relative to an undisturbed magnetic field of the earth, said unit comprising a 
processor configured to receive measurements of the distorted magnetic field from a 
magnetometer, receive an orientation of the vehicle axes with respect to the earth at a 
time corresponding to each magnetometer measurement, receive undistorted earth 
magnetic field data for the vicinity of the vehicle relative to the earth at the time 
corresponding to each magnetometer measurement, and characterize the distortions 
utilizing the magnetic field measurements, the orientations of the vehicle, and the 
undistorted earth magnetic field data. 

37. A magnetic compass compensation unit according to Claim 36, 
said processor receiving pitch and roll data from an attitude heading reference system. 

38. A magnetic compass compensation unit according to Claim 36 
wherein to characterize the distortions, said processor calculates correction 
coefficients based upon a magnetometer orientation with respect to the vehicle axes, 
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the magnetic field as measured by the magnetometer, magnetic inclination and 
declination data, and vehicle orientation. 

39. A magnetic compass compensation unit according to Claim 38 
wherein said processor is configured to calculate correction coefficients by estimating 
5 L e and H pe from the function H ea rth = L e * H meas + H pe where, H ear th is a three- 
dimensional vector representing the undisturbed Earth's magnetic field, H meas 
represents a three-dimensional vector for the disturbed Earth's magnetic field as 
measured by magnetometer, L e is a three by three (3x3) matrix of magnetic correction 
coefficients, and H pe is a three-dimensional vector of magnetic correction coefficients. 

10 40. A magnetic compass compensation unit according to Claim 36 

further configured to receive signals corresponding to magnetic sensors oriented in at 
least two different orientations. 

41. A magnetic compass compensation unit according to Claim 36 
further configured to receive signals corresponding to three magnetic sensors 

1 5 orthogonally oriented to one another. 

42. A magnetic compass compensation unit according to Claim 36 
further configured to determine vehicle orientation based upon a received GPS 
tracking angle. 

43. A magnetic compass compensation unit according to Claim 36 
20 further configured to determine a vehicle orientation based upon a true heading 

calculated utilizing GPS-augmented attitude and heading reference system algorithms. 

44. A magnetic compass compensation unit according to Claim 36 
further configured to determine a vehicle orientation based upon at least one of a true 
heading signal or a magnetic heading signal from an inertial reference system. 

25 45. A magnetic compass compensation unit according to Claim 36 

further configured to determine an orientation of the vehicle based upon a true 
heading received from a dual antenna GPS. 
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46. A magnetic compass compensation unit according to Claim 36 
wherein to receive undistorted earth magnetic field data said processor accesses a 
table of magnetic inclination and declination data for a surface of the earth. 

47. A magnetic compass compensation unit according to Claim 46 
5 wherein said processor is configured to transform undistorted earth magnetic field 

data to correspond to axes of the magnetometer. 

48. A processor programmed to generate a truth reference field 
vector, h., from inertial data and a three dimensional map of the earth's magnetic 

field, determine a difference between a vector as measured by the magnetometer and 
10 the truth reference vector, and utilize the difference to estimate corrections to 
magnetometer model coefficients. 

49. A processor according to Claim 48 wherein said processor 
comprises a Kalman filter for estimating corrections. 

50. A processor according to Claim 48 wherein said processor is 
1 5 programmed to generate a truth reference field vector by relating the field measured 

by a magnetometer h m to the true earth's field h according to h m = Mh + h p , where 

M is a 3x3 magnetic permeability matrix and h p is a 3x1 vector of field offset errors 
resulting from permanent magnetization. 

51. A processor according to Claim 50 wherein said processor is 

h = M- 1 (h m -h p ) 

20 programmed to solve for the true earth's field, h , according to , by 

= L(h m -h p ) 

assuming that the initial value of matrix L is equal to the identity matrix and the initial 
vector of field offset errors, h p , is zero. 

52. A processor according to Claim 51 wherein said processor is 
programmed to: 
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provide a linearized error equation for the magnetometer-measured and 
compensated body- axis earth's field components according to 

, where Ah is defined as Ah = h m -h ; and 

= £LAh-L£h p 

generate a separate measurement equation for each field component 
from the linearized error equation according to Sh x = Ah r <51 rl -l^^h , 

J/^ = Ah r £l r2 -l^Jh^, and = Ah r Jl r3 — l^cJh , where each equation is in the 

form of a row vector multiplied by a column vector of magnetometer parameter errors 
to provide scalars that are functions of the vectors. 

53. A processor according to Claim 52 wherein said processor is 
programmed with magnetometer errors according to 

ft.- 



<5h = 



Ah r 













'U3 

0 

Ah r 



54. A processor according to Claim 48 wherein to generate a truth 
reference field vector, h. , from inertial data and a three dimensional map of the earth's 
magnetic field, said processor is programmed to: 

determine the earth's field vector in north/east/down frame components 
based on one or more of a current latitude, longitude, altitude, and the map; and 

transform the earth's field vector into body coordinates to find errors in 
the "truth" source according to h. = Cf C^h* , where Cf transforms a vector from the 
local-level frame (L- frame) to the body frame (B-frame) and is the transpose of the 
attitude direction cosine matrix C, and accounts for the rotation in azimuth of the 
local-level frame with respect to north by the wander angle a , and is given by 
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cos a sin a 0 
-sin a cos a 0 
0 0 1 



55. A processor according Claim 54 wherein said processor is 
programmed to take partial differentials of h. =CfC^h* according to 

Shi = SC T C L N h N +C T SC L N h N +C r C L N Sh N 

rrr.-i f «** A? r r / . / i - a, t r - w > where y is the attitude error 
= [C r {y} ] C^h" + C r [ - {e} ] h" + C r C^h" 

vector which represents the angular error of the L- frame relative to the B-frame, e the 
angular position error vector which represents the angular error of the L- frame relative 
to the earth frame (E- frame), and {v} represents the skew-symmetric matrix form of 



the enclosed vector v, defined by {v} = 



0 -v. 
v. 



-v„ 



z y 

0 -v 
K 0 



56. A processor according Claim 55 wherein said processor is 
10 programmed to estimate corrections using a Kalman filter which implements a "psi- 

angle" inertial error model, the inertial error model having attitude error states that are 
components of an angular error vector \|/ defined as \|/ = y-e, which results in an 

error model of 5h t = C T { y } C^h^ + C r C^h" . 

57. A processor according to Claim 56 wherein said processor is 
15 programmed to determine a difference between a vector as measured by the 

magnetometer and a truth reference vector comprises according to z k = H k x k + \ k , 
where z k is a 3x1 vector of measurements at time t k , H k is a 3xn measurement 
matrix, is the state vector, and is the measurement noise vector. 

58. A processor according to Claim 57 wherein said processor is 
20 programmed to determine the measurement vector by subtracting 
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£h, = -C T {C L N h N }v + C T C L N 5h N from Sh = 



Ah r 0,, 3 0 U3 
0 Ix3 Ah r 0 
0,,3 Ah T 



Sl-L,Sh , resulting 



z = h - h, = <5h - (5h, + v 



in 



Ah' 0 lx3 0 U3 
0 lt3 Ah T 0 

o U3 o lx3 Ah r 



Sl-L,Sh p + C T {c L N h N }y-C T C L N 5h N + v ' 



where v 



represents a vector of uncorrelated measurement noise due to electromagnetic noise 
and random earth field modeling errors such as quantization. 

59. A processor according to Claim 58 wherein said processor is 
programmed to generate a measurement mapping matrix H according to 



h = [h„ 0 



0 H,, H 



H s"]> 



where 



Ah r 0 
0 



0. 



1*3 



0n3 0„ 3 



x3 V U3 

Ah r 0 
Ah r 



H c =-L 
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